APPENDIX A 



% BEGINNING OF PSEUDO CODE 

5 % compute scale factor A, and time constants a, b from physical system 

% parameters 

A = Vmax * Kt / (Re * Rm + Kt * Kb) * 1 * k; 

10 pi = 1/Jm/Ie * (-Ie * Rm - Re * Jm + sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 
+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 
p2 - 1/Jm/Ie * (-Ie * Rm - Re * Jm - sqrt(Ie A 2 * Rm A 2 - 2 * Re * Rm * Ie * Jm 
+ Re A 2 * Jm A 2 - 4 * Kt * Kb * Ie * Jm)) / 2; 

15 a = max(-p 1 ,-p2) 

b = min(-pl,-p2) 

% make initial guesses for step durations 

20 etl = 1; 

et2 = .005; 
et3 = 1; 



25 



% set maximum iteration count 



Nmax = 1000; 



for j = 1 :Nmax 

% save old values of step time intervals 
30 et3old = et3; 



■i 



et2old = et2; 
etlold = etl; 



% iterate for switch times using fixed voltage level Vmax 

5 

et3 = -log(l .0 / 2.0 - exp(-etl * a) / 2 + exp(-et2 * a)) / a; 

et2 - lib * log(2.0) + 3 * et3 - 1/b * log(2 * exp(l/A * b * X) * exp(et3 
* b) - sqrt( 4.0) * sqrt(exp(l/A * b * X)) * exp(et3 * b) * 
sqrt(exp(l/A * b * X)+exp(et3 * b) A 2 - 2 * exp(et3 * b))); 
10 etl = - (-2 * A * et2 + 2 * A * et3 - X) / A; 

if norm([et3old - et3 et2old - et2 etlold - etl], inf) <= eps * 2 
break 

end 

15 if j==Nmax 

error(['error - failure to converge after \ num2str(Nmax)/ 
iterations']) 

end 
end 

20 

% round up pulse duration to nearest sample interval, 

% convert to intervals between steps to make sure that voltage 

% requirements will not increase (beyond Vmax). 

25 dtl=ceil((etl - et2) / dt) * dt; 

dt2=ceil((et2-et3)/dt)*dt; 
dt3=ceil((et3) / dt) * dt; 

etl23 = [etl,et2,et3] 
30 % convert back to total step duration. 
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etl = dtl + dt2 + dt3; 
et2 = dt2 + dt3; 
et3 = dt3; 

5 % In the following, the original constraints equations involving XF1, XF2, 

% and XF3 have been modified to include a variable voltage level applied 

at 

% each step (instead of the fixed maximum (+/-) Vmax). 

1 0 % The original equations for XF 1 , XF2, and XF3 follow: 

% XFiCW) = VoFiOtod - to) - 2VoFi(t end - ti) + 2VoFi(tend - t 2 ) 

% XF 2 (tend) = VoF 2 (t t end-to)-2V 0 F 2 (t end -ti) + 2VoF 1 (t €nd -t 2 ) 

% XF 3 (te nd ) = VoF 3 (t t e„ d - to) - 2V 0 F 2 (t end - ti) + 2V 0 Fi(tend " t 2 ) 

15 % And the modified equation including adjustable relative levels of 

voltage 

% LI, L2 and L3 are: 

% XF^tenc) = LiVoFi(t te n d - to) - L 2 V 0 Fi(te„d - ti) + L 3 V 0 Fi(te„ d - t 2 ) 

% XF 2 (te„d) = LiVoF 2 (t tend - to) - L 2 V 0 F 2 (W - ti) + L 3 VoFi(te nd - 1 2 ) 
20 % XF 3 (t end ) = LiV 0 F 3 (tt eild -to)-L 2 VoF 2 (t e „d-ti) + L 3 VoF 1 (t end -t 2 ) 

% And the corresponding constraint equations are: 
% XFi(tend) = Finalpos 

% XF 2 (tend) = 0 

25 % XF 3 (te„ d ) = 0 

% Where all of the times indicated have discrete values, e.g. 
corresponding to 

% the controller update rate. 

30 
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% It should be noted that after the digital switch times are fixed, the 
constraint 

% equations derived from the equations above form a linear set of 
equations in 

5 % the unknown relative voltage levels LI, L2 and L3 and any standard 

linear 

% method can be used to solve for the relative voltage levels. In the 
equations 

% for (LI, L2 and L3) that follow, the solution was obtained by algebraic 
10 % means (and are not particularly compact.) 

% compute new relative voltage step levels 
% LI, L2 and L3 are nominally assigned to "1 ", "-2" and "+2", 
respectively 

15 si = X * (exp(-et3 * b) * exp(-et2 * a) + exp(-et3 * a) + exp(-et2 *b ) -exp(-et2 
*b) * exp(-et3 * a) - exp(-et2 * a) - exp(-et3 *b )); 
s2 = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a)- et2 * exp(-et3 * a) - et2 * exp(-etl * b) -et3 * 
exp(-etl * a) - exp(-et2 * b) * et3+exp(-et3 * b) * etl * exp(-et2 * 
20 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * 

exp(-et3 * a) - et3 * exp(-etl * b) * exp(-et2 * a) - exp(-et2 * a) * 
etl - exp(-et3 * b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

25 

LI = si * s2; 



si = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
30 exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * 
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exp(-et2 * a) + exp(-et3 * a) * etl+exp(-et2 * b) * etl - 
exp(-et2 * b) * etl * exp(-et3 * a) - et3 * exp(-etl * b) * 
exp(-et2 * a) - exp(-et2 * a) * etl - exp(-et3 * b) * etl - exp(-et3 * 
b) * et2 * exp(-etl * a) + et3 * exp(-etl * b) + et2 * exp(-etl * a) + 
5 exp(-et3 *b ) * et2 + et3 * exp(-et2 * a)) * X; 

s2 = (exp(-et2 * b) * exp(-etl * a) - exp(-etl * a) - exp(-et2 * b) - 

exp(-etl * b) * exp(-et2 * a) + exp(-etl * b) + exp(-et2 * a)) / A; 
L3 = sl*s2; 



10 si = exp(-etl * a) - exp(-et3 * a) + exp(-et3 * b) - exp(-etl * b) - 

exp(-et3 * b) * exp(-etl * a) + exp(-etl * b) * exp(-et3 * a); 
s2 = X / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * exp(-et2 * 
15 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * exp(- 

et3 * a) - et3 * exp(-etl * b) * exp(-et2 *a ) - exp(-et2 * a) * etl-exp(-et3 * 
b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

20 

L2= sl*s2; 



% convert accumulated voltage steps to sequential voltage level 
VI = Vmax* (LI); 
25 V2 - Vmax * (LI + L2); 

V3 = Vmax * (LI + L2 + L3); 



% END OF PSEUDO CODE 
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APPENDIX B 



AREA .. SUM(I,A(I)) =E= 0; 

VELOCITY(VINDX) .. VEL(VINDX) =E= VSCALE * 
5 SUM(I$(ORD(I) LE ORD(VINDX)), A(I)); 

POSITION .. SUM(I,VEL(I)) =E= FINALPOS * SCALEFACT; 
VLIMITP(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)),A(I- 
(ORD(VINDX)+l))*(VOLTS(VINDX)+KBACK*VSCALE)) 
=L= VOLTLIM; 

10 VLIMITN(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)), A(I- 

(ORD(VINDX)+l))*(VOLTS(VINDX)+KBACK*VSCALE)) 
=G= -VOLTLIM 

% A(I) are the current commands at time T(I) spaced equally at time DT. 
15 % VOLTS(VINDX) is a table of voltages representing the unit pulse 

response to 

% a unit output in current command. VOLTLIM is the voltage limit at 
saturation. 
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APPENDIX C 



GOALPOS .. SUM(I,A(I)*MODELAA*DT) =E=FINALPOS; 

MODEl(ILAST) .. SUM(I,-A(I)*MODELAA*MODELb/(MODELb- 

MODELa)*(EXP(-MODELa*(T(ILAST)+DT-T(I))) 

-EXP(-MODELa*(T(ILAST)-T(I))))) =E= 0.0; 

MODE2(ILAST) .. SUM(I,A(I)*MODELAA*MODELa/(MODELb- 

MODELa)*(EXP(-MODELb*(T(ILAST)+DT-T(I))) 

-EXP(-MODELb*(T(ILAST)-T(I))))) =E= 0.0; 

DERIV1(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 

SIN(WD(J)*T(I))) =E= 0.0 ; 

DERIV2(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 
COS(WD(J)*T(I))) =E= 0.0 ; 

% MODELAA is the mechanical gain of the system, MODELb, and MODELa 
% are the two time constants of the system in radians. One time constant is 
% associated with the L/R rise time of the motor inductance and the other is 
% the mechanical time constant of the rigid system. The A(I) are the voltages % 
which need to be determined. The T(I) are the times for each of the A(I). 

% DT is the time spacing of the outputs. W(J) are the undamped flexible 
% modes, WD(J) are the damped flexible modes (in radians/s). 
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